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(57) According to the prior art, a position controller 
has the problem that a low-frequency disturbance, and 
thus minute vibrations, may affect response because of 
the difficulty of adaptation to the phase of the vibrations. 
To solve the problem, there is provided a position con- 
troller, which comprises a subtractor (25) for subtracting 
a motor position signal from a movement position signal 
to produce an angle-of-twist signal; a high-pass filter 
(26) for advancing the phase of the angle-of-twist signal; 
a low-pass filter (27) for eliminating only high-fequency 
components of the signal received from the high-pass 
filter (26); a circuit (28) for multiplying the signal from 
the low-pass filter (27) by a torque-corrective gain to 
produce a torque-corrected signal; a torque correction 
evaluation section (29) for varying the torque-corrective 
gain according to a position deviation signal that is the 
difference between a position command and the move- 
ment position signal; and an adder (30) for combining 
the torque-corrective signal and the torque command to 
produce a new torque command. 
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Description 

Technical Field of the Invention 

[0001 ] The present invention relates to a position con- 5 
troller provided with a compensation means for sup- 
pressing vibration produced in a mechanism driven by 
a motor when the motor controls a position by driving 
an object to be controlled and, in particular, it relates to 
a position controller capable of positioning with high ac- 10 
curacy in a short time when a low-frequency disturbance 
is large. 

Background of the Art 

15 

[0002] Generally, for position control, a position signal 
of an encoder and the like attached to a servomotor is 
differentiated to produce a speed feedback signal and 
speed control is performed, and based on a position 
feedback signal from a position detector such as a linear 
scale and the like attached to a movement section driv- 
en by the servomotor (or an encoder and the like at- 
tached to the servomotor) , position control is performed. 
A block diagram of such a position control system is as 
shown in Fig. 9. 

[0003] In Fig. 9, 901 denotes a position control section 
and a position control gain is K P . 902 denotes a speed 
control section, 903 denotes a servomotor, and 904 de- 
notes a movement section. Position deviation e p is de- 
termined by subtracting position feedback signal y f from 
position command y r outputted from a numerical value 
controller and speed command v r is determined by mul- 
tiplying this position deviation by the position control 
gain K p . Speed deviation e v is determined by subtracting 
speed feedback signal v f from this speed command v r , 
torque command (current command) T r is determined 
based on said speed deviation e v in the speed control 
section 902, and the servomotor 903 and the movement 
section 904 are driven based on said torque command 
T r 

[0004] A control method for a motor whereby position 
control is performed based on a signal from a position 
detector such as a linear scale attached to a movement 
section driven by a motor is known as a closed loop 
method. However, if a motor and a movement section 
are spring -connected and the rigidity of the connected 
portion is weak, the movement of the motor and move- 
ment section does not coincide and vibration occurs. In 
such a case, it is necessary to stabilize the loop by low- 
ering a loop gain or to apply a method for stabilizing the 
loop, without lowering the loop gain, by correcting a 
torque command value based on a movement position, 
a movement speed and a motor position, or a motor 
speed. As a method for stabilizing the loop by correcting 
a torque command value, there is Japanese Unexam- 
ined Patent Publication No. Hei-3-1 10307, for example. 
Therein, the loop is stabilized by correcting the torque 
command value based on the difference between the 



2 

movement section speed and motor speed. A method 
whereby the loop is stabilized by correcting the torque 
command value based on the difference between the 
movement section speed and motor speed has also 
been indicated in the literature and the like (for example 
in 'The theory of AC servo system and practice of de- 
sign" written and edited by Hidehiko SUGIMOTO, Sou- 
go-denshi Shuppansha.) 

[0005] Fig. 8 is a block diagram for explaining the pri- 
or-art method whereby the loop is stabilized by correct- 
ing the torque command value. 

[0006] In Fig. 8,12 denotes a position control section 
in which position command Pref and detected move- 
ment position Pfbl are inputted and from which speed 
command Vref is outputted, and which position -controls 
a motor so that the abovementioned two input signals 
coincide, 13 denotes a speed control section in which 
the speed command Vref and operated motor speed 
Vfbm are inputted and from which torque command is 
outputted, and which speed-controls a motor so that the 
abovedescribed two input signals coincide, 18 denotes 
a speed processor which receives motor position signal 
Pfbm as an output signal from a motor position detector 
to differentiate the signal and outputs the abovede- 
scribed motor speed Vfbm, and 32 denotes a movement 
section speed processor which receives movement po- 
sition signal Pfbl as an output signal from a movement 
position detector to differentiate the signal and outputs 
movement speed Vfbl. 21 denotes a subtractor which 
subtracts the movement position Pfbl from the position 
command Pref and outputs a position deviation signal, 
22 denotes a position controller which receives the po- 
sition deviation signal and outputs speed command 
Vref, 23 denotes a subtractor which subtracts the motor 
speed signal Vfbm from the speed command Vref and 
outputs a speed deviation, 24 denotes a speed control- 
ler which receives the speed deviation and outputs 
torque command, 25 denotes a subtractor which oper- 
ates the difference between the movement speed signal 
Vfbl and the motor speed signal Vfbm to output, 28 de- 
notes a coefficient multiplier which multiplies the differ- 
ence between the abovedescribed movement speed 
signal Vfbl and the motor speed signal Vfbm by a coef- 
ficient a as a torque corrective gain and outputs the 
torque correction signal, and 31 denotes a subtractor 
which subtracts a torque correction signal from the 
torque command and outputs a new torque command 
Tref. 

[0007] Fig. 1 0 is a system construction view to which 
the position control system is applied. 100 denotes a 
base, 101 denotes a ball-screw, 102 denotes a table, 
103 denotes a servomotor, 104 denotes a linear scale 
for detecting a position of the table, and 105 denotes a 
measuring head. The servomotor 103 drives the table 
102 via the ball-screw 101. All of the drive mechanism 
and non-movement portions of to-be-driven bodies are 
fixed on the same base 1 00 and the base 1 00 is installed 
on the ground. The main body of the linear scale 1 04 is 
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arranged on the base 1 00 and the measuring head 1 05 
is attached on the table 102. The control system posi- 
tion-controls the table 102 based on a position signal 
from the linear scale 104. 

[0008] In recent years, the demand for higher speed 
industrial machines has increased, therefore a com- 
mand. is issued with an acceleration (deceleration) time 
made as short as possible (that is, by increasing accel- 
eration (deceleration) as far as possible) . In a case 
where the base 100 with a mechanism having a low ri- 
gidity is arranged on the ground, when the table is driven 
at high acceleration (deceleration), the base 100 re- 
ceives the reaction force of the acceleration (decelera- 
tion) and vibrates severely. For the control system, the 
vibration of the base 1 00 becomes a disturbance signal 
of a position signal. In addition, the lower the rigidity of 
the combination mechanism between the servomotor 
103 and the table 102 is, the greater the influence on 
positioning by the vibration of the base 100 becomes. 
[0009] However in the abovedescribed prior art of Fig. 
9, there has been a great drawback in that positioning 
with high accuracy is impossible in a short time when a 
large low-frequency disturbance exists. In the abovede- 
scribed prior art of Fig. 8, there have been problems in 
that when low-frequency disturbance exists and minute 
vibration occurs, the phase of the torque correction sig- 
nal and the phase of the vibration do not match each 
other, so the disturbance cannot be suppressed, there- 
by affecting the response. Also, since a speed signal is 
operated based on a position signal, there have been 
problems in that when the vibration is minute, sufficient 
resolution as a torque correction signal cannot be ob- 
tained and the loop cannot be stabilized. For example, 
since the speed signal is determined by differentiating 
the position signal, when the position signal is vibrating 
at a rate of several pulses, the waveform of the speed 
signal becomes coarse and the accuracy declines. 
Since the torque correction signal takes the difference 
between the coarse speed signals, its waveform be- 
comes coarser and sufficient resolution in not obtaina- 
ble. 

[0010] Therefore, the present invention aims to pro- 
vide a position controller capable of solving these prob- 
lems. 

Disclosure of the Invention 

[0011] In order to solve the abovedescribed prob- 
lems, according to the present invention, a position con- 
troller comprising: a position control section in which a 
position command and a detected movement position 
are inputted and from which a speed command is out- 
putted; a speed control section in which the speed com- 
mand and a motor speed are inputted and from which a 
torque command is outputted; a current control section 
which receives the torque command to perform amplifi- 
cation and outputs a current; a motor which rotates by 
being supplied with the current; a motor position detec- 



tor which detects a rotational displacement of the shaft 
of the motor and outputs a motor position signal; a speed 
processor which receives the motor position signal and 
outputs a motor speed signal; and a movement position 

5 detector which detects the position of a movement sec- 
tion driven by the motor and outputs a movement posi- 
tion signal and provided with: a motor speed-control 
function which makes the speed command and the mo- 
tor speed signal coincident by feedback control; and a 

10 motor position-control function which makes the posi- 
tion command and the movement position signal coin- 
cident by feedback control, wherein said position con- 
troller is provided with: 

15 a subtractor which subtracts the motor position sig- 
nal from the movement position signal and outputs 
an angle-of -twist signal; a high-pass filter which out- 
puts the angle-of-twist signal with its phase ad- 
vanced, upon receiving the angle-of-twist signal; a 
20 low-pass filter in which the signal from the high-pass 
filter is inputted and which outputs the signal with 
only its high-frequency components eliminated; a 
coefficient multiplier which receives the signal from 
the low-pass filter, multiplies it by a torque corrective 
25 gain, and outputs a torque correction signal; a sec- 
tion for torque correction evaluation which varies 
the torque corrective gain based on a positiomde- 
viation signal that is the difference between the'po- 
sition command and the movement position signal; 
30 and a subtracter which subtracts the torque correc- 
tion signal from the torque command to produce a 
new torque command, and further wherein: ~. 
in the section for torque correction evaluation, when 
the absolute value of the position deviation signal 
35 is greaterthan a reference value, the torque correc- 
tive gain is set to zero and when the absolute value 
of the position deviation signal changes to be equal 
to the reference value or below, the torque correc- 
tive gain is changed from zero to a constant value, 
40 or in the section for torque corrective gain change- 
over evaluation, when the absolute value of the po- 
sition deviation signal is greater than a reference 
value, the torque corrective gain is set to zero and 
when the absolute value of the position deviation 
45 signal changes to be equal to the reference value 
or below, the torque corrective gain is continuously 
changed from zero to a constant value. 

[0012] Also, according to the present invention, a po- 
50 sition controller comprising: a position control section in 
which a position command and a movement position are 
inputted and from which a speed command is outputted; 
a speed control section in which the speed command 
and a motor speed are inputted and from which a torque 
55 command is outputted; a current control section which 
receives the torque command to perform amplification 
and outputs a current; a motor which rotates by being 
supplied with the current; a motor position detector 
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which detects a rotational displacement of the shaft of 
the motor and outputs a motor position signal; a speed 
processor which receives the motor position signal and 
outputs a motor speed signal; and a movement position 
detector which detects the position of a movement sec- 
tion driven by the motor and outputs a movement posi- 
tion signal and provided with: a motor speed-control 
function which makes the speed command and the mo- 
tor speed signal coincident by feedback control; and a 
motor position-control function which makes the posi- 
tion command and the movement position signal coin- 
cident by feedback control, wherein said position con- 
troller is provided with: 

an observer which comprises a proportional oper- 
ating means for performing proportional operation, 
an integration operating means for multiplying by a 
gain co s 2 and performing integration operation, an 
inertia model for inputting a torque command out- 
putted from the speed control section, an adder 
which adds the output from the inertia model, the 
output from the proportional operating means, and 
the outputfrom the integration operating means, an 
integrator which integrates the output from the 
adder and outputs an estimated speed, and a sub- 
tractor which inputs a differential signal, obtained 
by subtracting the estimated speed from the motor 
speed outputted from the speed processor, into the 
proportional operating means and the integration 
operating means and which produces the differen- 
tial signal obtained by subtracting the estimated 
speed from the motor speed as an output; a high- 
pass filter which receives the output signal from the 
observer and . outputs .the output signal with its 
phase advanced; a low-pass filter in which the sig- 
nal from the high-pass filter is inputted and which 
outputs the signal with only its high-frequency com- 
ponents eliminated; a coefficient multiplier which re- 
ceives the signal from the observer and multiplies 
it by a torque corrective gain and outputs a torque 
correction signal; a section for torque correction 
evaluation which varies the torque corrective gain 
based on a position deviation signal that is the dif- 
ference between the position command and the 
movement position signal; and a subtractor which 
subtracts the torque correction signal from the 
torque command to produce a new torque com- 
mand, and further wherein; 

in the section fortorque correction evaluation, when 
the absolute value of the position deviation is great- 
er than a reference value, the torque corrective gain 
is set to zero and when the absolute value of the 
position deviation changes to be equal to the refer- 
ence value or below, the torque corrective gain is 
changed from zero to a constant value, or in the sec- 
tion for torque correction evaluation, when the ab- 
solute value of the position deviation signal is great- 
er than a reference value, the torque corrective gain 



is set to zero and when the absolute value of the 
position deviation signal changes to be equal to the 
reference value or below, the torque corrective gain 
is continuously changed from zero to a constant val- 
5 ue. 

[0013] Furthermore, according to the present inven- 
tion, a position controller of a movement section, which 
performs speed control based on a speed feedback sig- 

10 nal obtained by differentiating a rotational displacement 
signal of a servomotor and which performs position con- 
trol based on a position feedback signal from a position 
detector attached to a movement section driven by the 
servomotor or the rotating shaft of the servomotor, com- 

15 prises: a correction evaluation section which sets a var- 
iable gain to zero when a position deviation between a 
position command and the position feedback signal is 
greater than a predetermined reference value, and 
which sets the variable gain to a constant positive 

20 number when the position deviation becomes equal to 
the predetermined reference value or below; a differen- 
tial processing section which differentiates a value ob- 
tained by multiplying the position deviation by the vari- 
able gain; and a low-pass filter in which the output from 

25 this differential processing section is inputted and from 
which a speed command correction amount is output- 
ted, wherein the speed command correction amount is 
added to a speed command base amount to produce 
the speed command of the servomotor 

30 also, a position controller of a movement section, 

which performs speed control based on a speed feed- 
back signal obtained by differentiating a rotational dis- 
placement signal of a servomotor and which performs 
position control based, on a position . feedback signal. 

35 from a position detector attached to a movement section 
driven by the servomotor or the rotating shaft of the ser- 
vomotor, comprises: a correction evaluation section 
which sets a variable gain to zero when a position devi- 
ation between a position command and the position 

40 feedback signal is greater than a predetermined refer- 
ence value, and which sets the variable gain to a con- 
stant positive number when the position deviation be- 
comes equal to the predetermined reference value or 
below; and a high-pass filter in which a value obtained 

45 by multiplying the position deviation by the variable gain 
is inputted and from which a speed correction amount 
is outputted, wherein the speed command correction 
amount is added to a speed command base amount to 
produce the speed command of the servomotor. 

50 

Brief Description of Drawings 

[0014] Fig. 1 is a block diagram of the motor control 
system to which a first embodiment of the present in- 
55 vention is applied. Fig. 2 is a block diagram showing a 
first embodiment of the present invention. Fig. 3 are di- 
agrams for explaining the change in the torque correc- 
tive gain. Fig. 4 is a block diagram showing a second 
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embodiment of the present invention. Fig. 5 is a block 
diagram showing a third embodiment of the present in- 
vention. Fig. 6 is a diagram illustrative of a method for 
producing a speed command correction amount Fig. 7 
is a diagram illustrative of a method for producing a 5 
speed command correction amount. Fig. 8 is a block di- 
agram for explaining the prior-art method whereby the 
loop is stabilized by correcting the torque command val- 
ue. Fig. 9 is a block diagram of the prior-art position con- 
trol system. Fig. 10 is a system construction view to 
which the position control system is applied. 

Best Mode for Carrying Out the Invention 

[0015] Hereinafter, a first embodiment of the present 
invention will be described in detail based on the draw- 
ings. Fig. 1 is a block diagram of the motor control sys- 
tem to which the position controller of the present inven- 
tion is applied. In the drawing, 11 denotes a command 
generation section from which position command Pref 
is outputted, 12 denotes a position control section in 
which the position command Pref and detected move- 
ment position Pfbl are inputted and from which speed 
command Vref is outputted, and which position -controls 
a motor so that the two input signals coincide, 13 de- 
notes a speed control section in which the speed com- 
mand Vref and operated motor speed Vfbm are inputted 
and from which torque command is outputted, and 
which speed-controls a motor so that the two input sig- 
nals coincide, 14 denotes a current control section 
which receives the torque command Tref and supplies 
a current to the motor 15, 16 denotes a motor position 
detector (PG) which detects a rotational displacement 
of a rotating shaft by being connected to the rotating 
shaft of the motor .15, 1 7 denotes a movement position 
detector (external PG) which detects the position of ma- 
chine movement section 20 driven by the motor 15, 18 
denotes a speed processor which receives a motor po- 
sition signal Pfbm as an output signal from the motor 
position detector to differentiate the signal and outputs 
the abovedescribed motor speed Vfbm, 19 denotes a 
section for processing a torque-corrective signal in 
which the abovementtoned motor position signal Pfbm 
and a movement position signal Pfbl as an output signal 
from the movement position detector are inputted and 
from which a torque correction signal is outputted. 
[0016] Fig. 2 is a detailed block diagram showing an 
embodiment of the present invention. In the drawing, 21 
denotes a subtractor which subtracts the movement po- 
sition signal Pfbl from the position command Pref and 
outputs a position deviation signal, 22 denotes a posi- 
tion controller which receives the position deviation sig- 
nal and outputs speed command Vref, 23 denotes a sub- 
tractor which subtracts motor speed signal Vfbm from 
the speed command Vref and outputs a speed deviation 
signal, 24 denotes a speed controller which receives the 
speed deviation signal and outputs torque command, 25 
denotes a subtractor which operates the difference be- 



tween the movement position signal Pfbl and motor po- 
sition signal Pfbm and outputs an angle-of-twist signal, 
26 is a high-pass filter which outputs the angle-of-twist 
signal with its phase advanced, upon receiving the an- 
gle-of-twist signal, 27 denotes a low-pass filter which 
outputs the output signal from the high-pass filter with 
its high-frequency components eliminated, 28 denotes 
a coefficient multiplier which multiplies the output from 
the abovedescribed low-pass filter by a coefficient a as 
a torque corrective gain and outputs a torque correction 
signal, 29 denotes a section for torque correction eval- 
uation which varies the torque corrective gain based on 
the abovedescribed position deviation signal, and 30 
denotes a subtracter which subtracts the torque correc- 
tion signal from the torque command and outputs a new 
torque command Tref. 

[0017] If a motor and a movement section driven by 
the motor are spring-connected and the rigidity of the 
connected portion is weak, the loop can be stabilized by 
subtracting the difference between the movement sec- 
tion speed and motor speed, as the torque correction 
signal, from a torque command value, so that the vibra- 
tion can be eliminated. However, if there is a low-fre- 
quency disturbance and thereby minute vibration oc- 
curs, the phase of the vibration and the phase of the 
torque correction signal do not match each other, there- 
fore the vibration cannot be suppressed. In addition, 
since the speed signal is operated based on the position 
signal, if the vibration is minute, sufficient resolution as 
the torque correction signal cannot be obtained and the 
loop cannot be stabilized. Therefore, in the present-em- 
bodiment, the resolution as the torque correction signal 
is secured by setting the angle-of-twist signal, which is 
the difference between the movement position and-the 
motor position , to the torque correction value. Also; the 
vibration can be suppressed by advancing the phase of 
the torque correction signal by the high-pass filter 26 
and matching the phase of the vibration to the phase of 
the torque correction signal. Also, to suppress the 
minute vibration, it is necessary to set a large torque 
corrective gain, however if a large torque corrective gain 
is set, the overall response deteriorates. Accordingly, in 
the section for torque correction evaluation, by setting 
the torque corrective gain to 0 when the absolute value 
of the position deviation is greater than a predetermined 
reference value and by setting the torque corrective gain 
to a constant value when the absolute value of the po- 
sition deviation becomes equal to the predetermined 
reference value or below, only the minute vibration can 
be suppressed without changing the overall response 
even if a large torque corrective gain is set. Furthermore, 
by continuously changing the torque corrective gain, im- 
pacts when the torque corrective gain is changed can 
be reduced, whereby the loop is prevented from vibrat- 
ing. 

[0018] Fig. 3 are diagrams for explaining the change 
in thetorque corrective gain. In Fig. 3(a), the gain chang- 
es from zero to a without becoming a mean value at a 
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point where the absolute value of the position deviation 
becomes equal to the reference value or below. Also, in 
Fig. 3(b), the gain increases from zero to a with the 
elapse of time from a point where the absolute value of 
the position deviation becomes equal to the reference 
value or below. Effects in each case are as mentioned 
above. 

[0019] Fig. 4 is a detailed block diagram showing a 
second embodiment of the present invention. In the 
drawing, 421 denotes a subtractor which subtracts the 
movement position signal Pfbl from the position com- 
mand Pref and outputs a position deviation signal, 422 
denotes a position controller which receives the position 
deviation signal and outputs speed command Vref , 423 
denotes a subtractor which subtracts motor speed sig- 
nal Vfbm from the speed command Vref and outputs a 
speed deviation signal, 424 denotes a speed controller 
which receives the speed deviation signa! and outputs 
torque command, 425 denotes an observer in which the 
torque command Tref and the abovedescribed motor 
speed Vfbm are inputted to operate an estimated speed 
and from which a differential signal obtained by subtract- 
ing the estimated speed from the motor speed. The ob- 
server comprises proportional operating means 433 for 
performing proportional operation; integration operating 
means 434 for multiplying by a gain co s 2 and performing 
integration operation; inertia model 437 for inputting the 
torque command; adder 436 for adding the output from 
the inertia model, the output from the proportional oper- 
ating means, and the output from the integration oper- 
ating means; integrator 438 which integrates the output 
from the adder and outputs an estimated speed; and 
subtractor 435 which inputs a differential signal, ob- 
tained by.su btracting the estimated speed from the mo- 
tor speed, into the proportional operating means and in- 
tegration operating means. 426 denotes a high-pass fil- 
ter which receives the output signal from the observer 
and outputs the output signal with its phase advanced, 
427 denotes a low-pass filter which outputs the output 
signal from the high-pass filter with its high-frequency 
components eliminated, 428 denotes a coefficient mul- 
tiplier which multiplies the output from the abovede- 
scribed low-pass filter by a coefficient a as a torque cor- 
rective gain and outputs a torque correction signal, 429 
denotes a section for torque correction evaluation which 
varies the abovedescribed torque corrective gain based 
on the abovedescribed position deviation signal, and 
430 denotes a subtractor which subtracts the torque cor- 
rection signal from the torque command and outputs a 
new torque command Tref. 

[0020] If a motor and a movement section driven by 
the motor are spring-connected and the rigidity of the 
connected portion is weak, the loop can be stabilized by 
subtracting the difference between the movement sec- 
tion speed and motor speed, as the torque correction 
signal, from a torque command value, so that the vibra- 
tion can be eliminated. However, if there is a low-fre- 
quency disturbance and thereby minute vibration oc- 



curs, the phase of the vibration and the phase of the 
torque correction signal do not match each other, there- 
fore the vibration cannot be suppressed. In addition, 
since the speed signal is operated based on the position 

5 signal, if the vibration is minute, sufficient resolution as 
the torque correction signal cannot be obtained and the 
loop cannot be stabilized. Therefore, in the present em- 
bodiment, by operating an estimated speed by the ob- 
server and setting a differential signal, obtained by sub- 

10 tracting the estimated speed from the motor speed, to 
the torque corrective value, vibrational components can 
be detected at a high resolution even in the minute vi- 
bration having a low frequency, so that a torque correc- 
tion signal can be produced. Also, the vibration can be 

15 suppressed by advancing the phase of the torque cor- 
rection signal by the high-pass filter 426 and matching 
the phase of the vibration to the phase of the torque cor- 
rection signal. Also, to suppress the minute vibration, it 
is necessary to set a large torque corrective gain, how- 

20 ever if a large torque corrective gain is set, the overall 
response deteriorates. Accordingly, in the section for 
torque correction evaluation, by setting the torque cor- 
rective gain to 0 when the absolute value of the position 
deviation is greater than a predetermined reference val- 

25 ue and by setting the torque corrective gain to a constant 
value when the absolute value of the position deviation 
becomes equal to the predetermined reference value or 
below, only the minute vibration can be suppressed 
without changing the overall response even if a large 

30 torque corrective gain is set. Furthermore, by continu- 
ously changing the torque corrective gain , impacts when 
the torque corrective gain is changed can be reduced, 
whereby the loop is prevented from vibrating. 

[0021 ]„ A third embodiment of the present invention 

35 will be described with reference to the drawings. Fig. 5 
is a constructional block diagram of the principal of the 
control system. Fig. 5 shows a prior-art position control 
system to which a section for correcting speed com- 
mand 508 is added. Position deviation e p between po- 

40 sition command y r and position feedback signal y f from 
position detector 506 such as a linear scale is operated. 
When the position control system constructs a semi- 
closed loop, a position feedback signal can be obtained 
from encoder 505 attached to servo motor 503 and po- 

45 sition deviation e p is operated. In position control section 
501 , speed command base amount v^ is determined by 
multiplying the abovedescribed position deviation e p by 
position control gain Kp, and speed command correction 
amount v^ is operated in the section for correcting 

so speed command 508 based on the abovementioned po- 
sition deviation e p , which will be mentioned below. A sig- 
nal in that the speed command base amount and the 
speed command correction amount v^ are synthesized 
is set as speed command v r . Speed control section 502 

55 operates torque command T r based on speed deviation 
e v between the abovementioned speed command v r 
and speed feedback signal v f obtained, in differential 
processing section 507, by differentiating servomotor 
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position signal y m from the encoder 505 attached to the 
servomotor 503, and outputs the torque command T r to 
the servomotor 503. 

[0022] Fig. 6 and Fig. 7 are diagrams each illustrative 
of a method for producing a speed command correction 
amount, showing one embodiment of the present inven- 
tion. In Fig. 6, when the abovedescribed position devi- 
ation e p is greater than predetermined reference value 
E p , correction evaluation section 601 sets variable gain 
K d of gain setting section 602 to 0 and when the above- 
described position deviation e p becomes equal to the 
predetermined reference value E p or below, the above- 
mentioned correction evaluation section 601 sets the 
abovementioned variable gain K d to a constant positive 
number, and a value obtained by multiplying the above- 
described position deviation e p by the variable gain K d 
is differentiated in differential processing section 603 
and becomes speed command correction amount v^ 
via low-pass filter 604 (1/(1 +ts) : t indicates time con- 
stant, s indicates Laplacian operator, the same is ap- 
plied in thefollowing.) On the other hand, in Fig. 7, when 
the abovedescribed position deviation e p is greater than 
predetermined reference value E p , correction evalua- 
tion section 601 sets variable gain K h of gain setting sec- 
tion 705 to 0 and when the abovedescribed position de- 
viation e p becomes equal to the predetermined refer- 
ence value E p or below, the abovementioned correction 
evaluation section 601 sets the abovementioned varia- 
ble gain K h to a constant positive number, and a value 
obtained by multiplying the abovedescribed position de- 
viation e p by the variable gain K h becomes speed com- 
mand correction amount v^ via high-pass filter 706 (ts/ 
(1+ts)). To set the variable gains K d and K h to constant 
positive numbers in Figs. 6 and 7 means to add a damp- 
ing compensator into the position loop system. That. is, 
when the position deviation e p becomes small, an effec- 
tive damping effect is created to suppress the low-fre- 
quency disturbance and on the other hand, when the 
position deviation e p becomes large, a damping effect 
is eliminated, therefore it is possible to make a control 
amount follow a target quickly, whereby shortening the 
overall positioning time. 

Industrial Applicability 

[0023] As has been described above, in the case 
where the control is performed by the closed loop meth- 
od, the present invention can provide a position control- 
ler capable of controlling only the vibration without af- 
fecting the overall response even when the low-frequen- 
cy disturbance exists and the minute vibration occurs. 
[0024] Also, when low-frequency disturbance exists 
in a large amount, a positioning time can be shortened 
by adjusting the variable gain of the section for correct- 
ing speed command depending on the size of the posi- 
tion deviation. 

[0025] To carry out the speed command correction 
only when the position deviation became equal to a pre- 



determined reference value or below makes it possible, 
when the movement section which was controlled is far 
from the target position, to eliminate the damping effect 
and cause the control amount to follow the target quick- 
5 |y, and when the movement section which was control- 
led becomes close to the target position, to make the 
damping effect effective and suppress the low-frequen- 
cy disturbance, and thereby realize positioning with high 
accuracy in a short time. 

10 

Claims 

1. A position controller comprising: a position control 
15 section in which a position command and a detect- 
ed movement position are inputted and from which 
a speed command is outputted; a speed control 
section in which the speed command and a motor 
speed are inputted and from which a torque com- 

20 mand is outputted; a current control section which 
receives the torque command to perform amplifica- 
tion and outputs a current; a motor which rotates by 
being supplied with the current; a motor position de- 
tector which detects a rotational displacement of the 

25 shaft of the motor and outputs a motor position sig- 
nal; a speed processor which receives the motor 
position signal and outputs a motor speed signal; 
and a movement position detector which detects 
the position of a movement section driven by the 

30 motor and outputs a movement position signal; and 
provided with: a motor speed-control function which 
makes the speed command and the motor speed 
signal coincident by feedback control; and a motor 
position-control function which makes the position 

35. . command and the movement.position signal coin-. . 
cident by feedback control wherein said position 
controller is provided with: 

a subtractor which subtracts the motor posi- 
tion signal from the movement position signal and 

40 outputs an angle-of-twist signal; a high-pass filter 
which outputs the angle-of-twist signal with its 
phase advanced, upon receiving the angle-of-twist 
signal; a low-pass filter in which the signal from the 
high-pass filter is inputted and which outputs the 

45 signal with only its high-frequency components 
eliminated; a coefficient multiplier which receives 
the signal from the low-pass filter, multiplies it by a 
torque corrective gain, and outputs a torque correc- 
tion signal; a section for torque correction evalua- 

50 tion which varies the torque corrective gain based 
on a position deviation signal that is the difference 
between the position command and the movement 
position signal; and a subtracter which subtracts the 
torque correction signal from the torque command 

55 to produce a new torque command. 

2. A position controller as set forth in Claim 1 , wherein 

in said section for torque correction evalua- 
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tiorv when the absolute value of the position devia- 
tion signal is greater than a reference value, the 
torque corrective gain is set to zero and when the 
absolute value of the position deviation signal 
changes to be eq ual to the reference value or below, 5 
the torque corrective gain is changed from zero to 
a constant value. 

3. A position controller as set forth in Claim 1 , wherein 

in said section for torque correction evalua- 10 
tion, when the absolute value of the position devia- 
tion signal is greater than a reference value, the 
torque corrective gain is set to zero and when the 
absolute value of the position deviation signal 
changes to be equal to the reference value or below, 15 
the torque corrective gain is continuously changed 
from zero to a constant value. 

4. A position controller comprising: a position control 
section in which a position command and a move- 20 
ment position are inputted and from which a speed 
command is outputted; a speed control section in 
which the speed command and a motor speed are 
inputted and from which a torque command is out- 
putted; a current control section which receives the 25 
torque command to perform amplification and out- 
puts a current; a motor which rotates by being sup- 
plied with the current; a motor position detector 
which detects a rotational displacement of the shaft 

of the motor and outputs a motor position signal; a 30 
speed processor which receives the motor position 
signal and outputs a motor speed signal; and a 
movement position detector which detects the po- 
sition of a movement section driven by the motor . 
and outputs a movement position signal and provid- 35 
ed with: a motor speed-control function which 
makes the speed command and the motor speed 
signal coincident by feedback control; and a motor 
position -control function which makes the position 
command and the movement position signal coin- 40 
cident by feedback control, wherein said position 
controller is provided with: 

an observer which comprises a proportional 
operating means for performing proportional oper- 
ation, an integration operating means for multiply- *s 
ing by a gain co s 2 and performing integration oper- 
ation, an inertia model for inputting a torque com- 
mand outputted from the speed control section, an 
adder which adds the output from the inertia model, 
the output from the proportional operating means, so 
and the output from the integration operating 
means, an integrator which integrates the output 
from the adder and outputs an estimated speed, 
and a subtractor which inputs a differential signal, 
obtained by subtracting the estimated speed from 55 
the motor speed outputted from the speed proces- 
sor, into the proportional operating means and the 
integration operating means and which produces 



the differential signal obtained by subtracting the 
estimated speed from the motor speed as an out- 
put; a high-pass filter which receives the output sig- 
nal from the observer and outputs the output signal 
with its phase advanced; a low-pass filter in which 
the signal from the high-pass filter is inputted and 
which outputs the signal with only its high-frequency 
components eliminated; a coefficient multiplier 
which receives the signal from the low-pass filter 
and multiplies it by a torque corrective gain and out- 
puts a torque correction signal; a section for torque 
correction evaluation which varies the torque cor- 
rective gain based on a position deviation signal 
that is the difference between the position com- 
mand and the movement position signal; and a sub- 
tractor which subtracts the torque correction signal 
from the torque command to produce a new torque 
command. 

5. A position controller as set forth in Claim 4, wherein 

in said section for torque correction evalua- 
tion, when the absolute value of the position devia- 
tion is greater than a reference value, the torque 
corrective gain is set to zero and when the absolute 
value of the position deviation changes to be equal 
to the reference value or below, the torque correc- 
tive gain is changed from zero to a constant value, 

6. A position controller as set forth in Claim 4, wherein 

in the section fortorque correction evaluation, 
when the absolute value of the position deviation 
signal is greater than a reference value, the torque 
corrective gain is set to zero and when the absolute 
value of the position deviation signal changes to be 
equal to the reference value or below, the torque 
corrective gain is continuously changed from zero 
to a constant value. 

7. A position controller of a movement section, which 
performs speed control based on a speed feedback 
signal obtained by differentiating a rotational dis- 
placement signal of a servomotor and which per- 
forms position control based on a position feedback 
signal from a position detector attached to a move- 
ment section driven by the servomotor or the rotat- 
ing shaft of the servomotor, comprises: a correction 
evaluation section which sets a variable gain to zero 
when a position deviation between a position com- 
mand and the position feedback signal is greater 
than a predetermined reference value, and which 
sets the variable gain to a constant positive number 
when the position deviation becomes equal to the 
predetermined reference value or below; a differen- 
tial processing section which differentiates a value 
obtained by multiplying the position deviation by the 
variable gain; and a low-pass filter in which the out- 
put from this differential processing section is input- 
ted and from which a speed command correction 
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amount is outputted, wherein 

the speed command correction amount is 
added to a speed command base amount to pro- 
duce the speed command of the servomotor. 

5 

A position controller of a movement section, which 
performs speed control based on a speed feedback 
signal obtained by differentiating a rotational dis- 
placement signal of a servomotor and which per- 
forms position control based on a position feedback 10 
signal from a position detector attached to a move- 
ment section driven by the servomotor or the rotat- 
ing shaft of the servomotor, comprises: a correction 
evaluation section which sets a variable gain to zero 
when a position deviation between a position com- is 
mand and the position feedback signal is greater 
than a predetermined reference value, and which 
sets the variable gain to a constant positive number 
when the position deviation becomes equal to the 
predetermined reference value or below; and a 20 
high-pass filter in which a value obtained by multi- 
plying the position deviation by the variable gain is 
inputted and from which a speed correction amount 
is outputted, wherein 

the speed command correction amount is 25 
added to a speed command base amount to pro- 
duce the speed command of the servomotor. 
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